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METHOD FOR COMPENSATING ROTATIONAL POSITION ERROR OF ROBOT 
CLEANER 

BACKGROUND OF THE INVENTION 

5 

1 . Field of the Invention 

The present invention relates to a robot cleaner and, more particularly, to 
a method for compensating a rotational position error of a robot cleaner, which is 
capable of minimizing a rotational position error of a robot cleaner. 

10 

2. Description of the Background Art 

In general, a robot cleaner is operated by the steps of detecting a region 
for a cleaning operation along a wall surface of a room (e.g., a living room or the 
inner room) of a house and returning to an original position; performing a cleaning 
is operation along the cleaning path of the detected cleaning region; and moving to a 
charger and automatically charging a battery of a robot cleaner when the cleaning 
operation is completed. 

Thus, in each step of the cleaning operation, accurate calculation of 
positions of the robot cleaner (e.g., 'x'-axis direction, y-axis direction or rotational 
20 direction) is a critical factor in determining a cleaning performance. Especially, a 
size of a rotational position error of the robot cleaner in the step of performing the 
cleaning operation in a certain pattern is crucial to the cleaning performance. 

There are various methods for determining a position of the robot cleaner. 
For example, one of methods for calculating an absolute position of the 
25 robot cleaner is using a GPS (Global Positioning System). However, in spite of its 
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advantage of obtaining an absolute position, this method has a problem that if the 
GPS is used in a limited space such as in a building, the precision of the GPS is 
degraded. That is, the GPS can not be substantially employed in the building. 

Another method is obtaining a rotational speed and a straight-forward 

5 speed from an encoder (not shown) installed in the robot cleaner and integrating 
the obtained rotational speed and the straight-forward speed in order to determine 
a relative position of the robot cleaner. 

However, using of the encoder incurs a low cost in implementing the robot 
cleaner, but a rotational position error occurs due to a state of a bottom surface, 

10 an assembly error of the robot cleaner, a slip, or the like, and in addition, it is 
difficult to calculate the rotational position error. 

A third method is obtaining a rotational position of the robot cleaner by 
integrating an angular velocity of gyro sensor, For example, the gyro sensor 
outputs 2.5 volt when the robot cleaner is not rotated. When the robot cleaner is 

is rotated at an angular velocity of 907sec clockwise, the gyro sensor outputs 5.0 
volt. When the robot cleaner is rotated at an angular velocity of 907sec 
counterclockwise, the gyro sensor outputs 0 volt. If a sensor value of the gyro 
sensor is 1 .25 volt, it means that the robot cleaner is rotated at an angular velocity 
of 457sec counterclockwise. 

20 However, in the present invention, an important fact was noted through 

various experiments and try-and-error that when a rotational position of the robot 
cleaner is calculated by using the gyro sensor, an offset value of the gyro sensor 
changes as time passes, and if the changed offset value is not compensated, the 
rotational position errors of the robot cleaner are accumulated. 

25 That is, though the gyro sensor for measuring the rotational speed 
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(angular velocity) has such advantages that an error of an encoder does not occur 
with respect to the state of the bottom surface, an external impact or in case of 
collision to an object, accumulation of the rotational position errors due to the 
offset value of the gyro sensor degrades the cleaning performance of the robot 
5 cleaner. 

Meanwhile, conventional techniques with respect to the robot cleaner is 
disclosed in US Patent No. 5,440,216, and the gyro sensor of the robot cleaner is 
disclosed in the US Patent No. 5,646,494. 



10 SUMMARY OF THE INVENTION 



Therefore, an object of the present invention is to provide a method for 
compensating a rotational position error of a robot cleaner capable of reducing a 
rotational position error of a robot cleaner by compensating an offset value of a 

15 gyro sensor of the robot cleaner. 

Another object of the present invention is to provide a method for 
compensating a rotational position error of a robot cleaner capable of minimizing a 
rotational position error of a robot cleaner by compensating an offset value of a 
gyro sensor of the robot cleaner whenever the robot cleaner temporarily stops. 

20 Still another object of the present invention is to provide a method for 

compensating a rotational position error of a robot cleaner capable of minimizing a 
rotational position error of a robot cleaner by compensating an offset value of a 
gyro sensor of the robot cleaner after temporarily stopping the robot cleaner when 
the robot cleaner starts a cleaning operation by steps. 

25 Yet another object of the present invention is to provide a method for 



compensating a rotational position error of a robot cleaner capable of minimizing a 
rotational position error of a robot cleaner by compensating an offset value of a 
gyro sensor of the robot cleaner when the robot cleaner temporarily stops in place 
to change its direction from that place in a state that a pre-set time elapses. 

5 Another object of the present invention is to provide a method for 

compensating a rotational position error of a robot cleaner in which a sample 
average value of offsets of a gyro sensor when a robot cleaner temporarily stops 
is obtained, and if the sample average value is much different from an actual offset 
value of the gyro sensor, the robot cleaner temporarily stops and the offset value 

10 of the gyro sensor of the robot cleaner is compensated to thereby minimize a 
rotational position error of the robot cleaner. 

To achieve these and other advantages and in accordance with the 
purpose of the present invention, as embodied and broadly described herein, 
there is provided a method for compensating a rotational position error of a robot 

15 cleaner including: detecting an offset value of a sensor for detecting a rotational 
speed of a robot cleaner; compensating the detected offset value; and correcting a 
rotational position of the robot cleaner on the basis of the compensated offset 
value. 

To achieve the above objects, there is also provided a method for 
20 compensating a rotational position error of a robot cleaner including: detecting an 
offset value of a gyro sensor after stopping a robot cleaner for a predetermined 
time when the robot cleaner is in an offset compensation mode; obtaining an 
average value of the detected offset values and a standard deviation; averaging 
the noise-removed offset value on the basis of the average value and the standard 
25 deviation; determining the averaged offset value as a new gyro offset value; and 
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compensating a rotational position error of the robot cleaner on the basis of the 
new gyro offset value. 

The foregoing and other objects, features, aspects and advantages of the 
present invention will become more apparent from the following detailed 
5 description of the present invention when taken in conjunction with the 
accompanying drawings. 

BRIEF DESCRIPTION OF THE DRAWINGS 

10 The accompanying drawings, which are included to provide a further 

understanding of the invention and are incorporated in and constitute a part of this 
specification, illustrate embodiments of the invention and together with the 
description serve to explain the principles of the invention. 
In the drawings: 

15 Figure 1 is a block diagram showing a general construction of a robot 

cleaner; 

Figure 2 illustrates a coordinate system applied for compensating a gyro 
offset value of a robot cleaner in accordance with a preferred embodiment of the 
present invention; 

20 Figure 3 is a flow chart of a method for compensating a rotational position 

error of the robot cleaner in accordance with the preferred embodiment of the 
present invention; and 

Figures 4A to 4D show processes for compensating a rotational amount 
on the basis of a new gyro offset value in accordance with the preferred 

25 embodiment of the present invention. 
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DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 



Reference will now be made in detail to the preferred embodiments of the 
present invention, examples of which are illustrated in the accompanying drawings. 
5 A method for compensating a rotational position error of a robot cleaner in 

which a rotational position error of a robot cleaner is reduced by minimizing a 
rotational position error of a robot cleaner by compensating an offset value of a 
sensor detecting a rotational speed of the robot cleaner in accordance with a 
preferred embodiment of the present invention will now be described. 
10 Figure 1 is a block diagram showing a general construction of a robot 

cleaner. A construction of a general robot cleaner related to the present invention 
will be described, while a description on a construction of the general robot 
cleaner which is not directly related to the present invention is omitted. 

First, positions (X n , Y n , \|/ n ) of the general robot cleaner are updated at 
15 every sampling time by the below equation (1): 
X n+x =X n +cosW n V n At 

y n+1 =F n +sin4V^A* (1) 

wherein X n , Y n , \|/ n are positions of a robot cleaner, V n is a speed of a forward 
20 direction of the robot cleaner, co n is an angular velocity of the robot cleaner, At is 

a sampling time. 

The speed of the forward direction (V n ) of the robot cleaner is obtained by 
using an accelerometer or an encoder as in the conventional art. Y n+ i is a current 
rotational amount of the robot cleaner, \|/ n is a previous rotational amount of the 
25 robot cleaner, and co n A\ is a rotational amount according to a current rotation 



speed. 

Figure 2 illustrates a coordinate system applied for compensating a gyro 
offset value of a robot cleaner in accordance with a preferred embodiment of the 
present invention. That is, when the robot cleaner is initialized, the center of the 

5 robot cleaner is taken as the starting point of a coordinate axis. At this time, it is 
assumed that the forward direction of the robot cleaner is X axis and the 
perpendicular direction by 90° to X axis counterclockwise is Y axis. Positions of 
the robot cleaner in nth sampling are expressed by X n , Y n and \|/ n . \j/ n means an 
angle between X axis and the forward direction of the robot. 

10 The angular velocity (co n ) of the robot cleaner is calculated on the basis of 

an output value of the gyro sensor. That is, the angular velocity (co n ) of the robot 
cleaner is calculated through the below equation (2), and a rotational position of 
the robot cleaner is calculated by accumulatively adding up the calculated angular 
velocities (co n ). 

15 C0 n = C(G n - Goffset) (2) 

wherein G n is an actual output value of the gyro sensor, Goffset is an output value of 
the gyro sensor when an angular velocity of the robot cleaner is 0, that is, gyro 
offset value [mV], and 'C is a scale vector [deg/sec/mV] for converting an output 
value of the gyro sensor into an angular velocity. 
20 However, because an offset value of the gyro sensor is changed over time 

and an environment, the changed offset value of the gyro sensor should be 
compensated in order to accurately calculate a rotational position of the robot 
cleaner. 

That is, in the present invention, as mentioned above, an important fact 
25 was noted through various experiments and try-and-error that when a rotational 



position of the robot cleaner is calculated by using the gyro sensor, an offset value 
of the gyro sensor changes as time passes, and if the changed offset value is not 
compensated, the rotational position errors of the robot cleaner are accumulated. 

For example, a state that a speed error of 0.1 [deg/sec] has occurred due 
5 to a change in the gyro offset value is maintained for 10 minutes, a rotational 
position error of total 60 [deg] = (0.1x60x10) is generated. Accordingly, the 
automatic traveling robot cleaner, which performs a cleaning operation with map 
information, can not perform the cleaning operation due to the rotational position 
error of 60 [deg]. 

io The method for compensating a rotational position error of a robot cleaner 

in accordance with the preferred embodiment of the present invention will now be 
described in detail with reference to Figure 3 and Figures 4A-4D. 

Figure 3 is a flow chart of a method for compensating a rotational position 
error of the robot cleaner in accordance with the preferred embodiment of the 

15 present invention. 

First, when the mode of the robot cleaner is changed to an offset 
compensation mode to correct an offset value of the gyro sensor, the robot cleaner 
performs an operation to correct a rotational position error of the robot cleaner. At 
this time, it is also preferred that the offset compensation mode is operated to 

20 correct the rotational position error of the robot cleaner when the robot cleaner 
temporarily stops (step S11). 

Meanwhile, the mode of the robot cleaner is not the offset compensation 
mode for correcting an offset value of the gyro sensor, the robot cleaner performs 
a cleaning operation or a charging operation (step S12). 

25 Thereafter, it is determined that the cleaning operation of the robot cleaner 
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is complete. If the cleaning operation is not completed, it returned to the step S11 
to determine whether the robot cleaner in the offset compensation mode (step 
S13). 

The offset compensation mode is performed when the robot cleaner 

5 temporarily stops, or performed in various situations as necessary. That is, only 
when the robot cleaner is maintained in the stop state, the gyro offset value can be 
compensated without interruption to the cleaning operation and the charging 
operation. Accordingly, in the present invention, preferably, the robot cleaner 
temporarily stops in the below three cases and the offset compensation mode is 

10 performed (step S13). 

First, preferably, when the robot cleaner starts a cleaning operation, the 
offset compensation mode is executed after the robot cleaner temporarily stops. 

For example, after the robot cleaner temporarily stops, the offset 
compensation mode is executed at a point when the robot cleaner performs a 

15 cleaning operation along a wall (e.g., the wall of a living room of a house), at a 
point when a cleaning operation is performed in a certain pattern on the basis of a 
map created for a cleaning region, or at a point .when the robot cleaner is moved 
to a charger and a battery of the robot cleaner is charged after the cleaning 
operation is completed. 

20 Second, preferably, the offset compensation mode is performed at pre-set 

time intervals. For example, the offset compensation mode is performed after a 
pre-set time (e.g., 10 minutes) elapses and the robot cleaner temporarily stops 
while the cleaning operation is being performed by each step. That is, when the 
robot cleaner temporarily stops to change its direction from a current position after 

25 the pre-set time elapses, the offset value of the gyro sensor is compensated, 
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thereby minimizing a rotational position error of the robot cleaner. 

Third, preferably, the offset compensation mode is performed when the 
robot cleaner temporarily stops for the reason of a direction change during the 
cleaning operation. For example, the robot cleaner is rotated in the original place 

5 in order to change its direction, and in a stop state for a rotational direction for a 
short time of a start point and an end point. At this time, an output value of the 
gyro sensor is an actual offset value of the gyro sensor with a rotation speed of 0. 
At this time, a sample average value of the offsets of the gyro sensor is obtained 
and, if the obtained sample average value and an offset value of the gyro sensor 

10 used for calculation of an angular velocity are much different, preferably, the robot 
cleaner stops for a predetermined time and is performed. The sample average 
value of the gyro offsets is obtained by below equation (3): 

s 

C — i=1 /o\ 

^ offset , sample g \ / 

wherein 'S' is the number of samples of output values of the gyro sensor that can 
15 be collected when the robot cleaner instantly stops, G. is an output value of the 
gyro sensor when the robot cleaner instantly stops, and G 0 ffset,sam P ie is an average 
value of output values of the gyro sensor when the robot cleaner instantly stops. 

Accordingly, if a difference value between the average value (G 0 ffset,sampie) 
of the gyro sensor values calculated according to equation (3) and an offset 
20 (Goffset) value of the gyro sensor used for calculation of the actual angular velocity 
are much different, it means that the actual offset value of the gyro sensor has 
been changed. When the offset value of the gyro sensor is changed, the robot 
cleaner temporarily stops and the offset compensation is performed. 

Thereafter, if the mode of the robot cleaner is changed to the offset 



compensation mode, the robot cleaner is maintained in the stop state (step S14) 
and an offset value of the gyro sensor is detected. That is, in a state that the robot 
cleaner temporarily stops, the predetermined number of output values of the gyro 
sensor is collected (step S15). Herein, when the robot cleaner stops (that is, when 
5 the rotation speed is 0), the output value of the gyro sensor becomes an offset 
value of the gyro sensor. In this respect, because there is a noise component 
whenever measured and the offset value is changed over time, it is preferred to 
use an average value and a standard deviation in order to obtain an accurate 
offset value of the gyro sensor. 

10 When the offset value of the gyro sensor is detected, an average value of 

the obtained offset values of the gyro sensor and a standard deviation are 
obtained. The average value and the standard deviation are calculated through 
below equation (4). That is, equation (4) is to obtain an average value of the 
output values of the gyro sensor and the standard deviation when the robot 

15 cleaner temporarily stops. 

*"a* a o>^-^ (4) 

wherein m G ,i is an average value of the output values of the gyro sensor, '1ST is the 
number of samplings of the gyro sensor, Gj is an output value of the gyro sensor, 
a G ,i is a standard deviation of the output value of the gyro sensor (step S16). 
20 Thereafter, the offset values of the gyro sensor without a noise are 

averaged on the basis of the standard deviation, and the averaged offset value is 
determined as a new gyro offset value (G 0 ffset,new). At this time, the new gyro offset 
value (Gotfset.new) is calculated through below equation (5). That is, equation (5) is 
to obtain the average value of the gyro sensor values without a noise by 



probability, and the obtained average value becomes the new gyro offset value 
(stepS 17). 

N 

G offset, new ~ m G,2 = (5) 

1=1 

wherein 1713,2 is an average value of the offset values of the gyro sensor without a 

5 noise, and Gj is an offset value of the gyro sensor. When the rotation speed is 0, 
an output value of the gyro sensor is an offset value of the gyro sensor. 

In addition, if the offset value of the gyro sensor is a noise by probability, Vj 
is 0, otherwise, it is 1. That is, if \G i -m G1 \< k x cr G1 , then V t is T, while if 
I G i ~ m G,i I- K ' °g,\ 1 then V i is '0 1 - At this time > the angular velocity (o) n ) is 

10 calculated on the basis of the new gyro offset value (G 0 ffset,new). Namely, the 
angular velocity co n = C(G n - G 0 ffset,new). 

Thereafter, the angular velocities (o) n ) calculated on the basis of the new 
gyro offset value are accumulatively added up and a rotation amount of the robot 
cleaner is calculated through an equation *F n+l = ¥ n + co n At. And then, the calculated 

15 rotation amount is subtracted from a previously calculated rotation amount, and 
the subtracted rotation amount is compensated to thereby reduce a rotational 
position error of the robot cleaner. That is, whenever the new gyro offset value is 
determined, the rotation amount according to the change in the gyro offset is 
compensated, thereby reducing the rotational position error of the robot cleaner 

20 (step S18). 

A method for calculating the rotation amount of the robot cleaner on the 
basis of the new gyro offset value and compensating the calculated rotation 
amount will now be described in detail with reference to Figures 4A-4D. 
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Figures 4A to 4D show processes for compensating a rotational amount 
on the basis of a new gyro offset value in accordance with the preferred 
embodiment of the present invention. 

With reference to Figure 4A, when the robot cleaner is moved in the stop 
5 state, an offset value of the gyro sensor is changed during the time interval of toid 
to t new while the robot cleaner is being moved. A shaded area indicates an actual 
rotation amount of the robot cleaner. However, if the gyro offset value is changed 
while the robot cleaner is being moved during the time interval of toid to the time 
interval of t ne w, the change amount can not be known. Thus, the shaded area of 
10 Figure 4A can be accurately obtained by using the gyro sensor. 

With reference to Figure 4B, due to the changed offset value, there occurs 
a rotational position error, and the robot cleaner can not perform a cleaning 
operation due to the error. A shaded area of Figure 4B indicates the amount of 
rotation of the robot cleaner obtained by calculating the angular velocities when 
15 assuming the gyro offset value as a constant and accumulatively adding the 
calculated angular velocities. 

At this time, the rotational position error is the area obtained by subtracting 
the shaded area of Figure 4A from the shaded area of Figure 4B. That is, the 
rotational position error (Err 1= Ai - A 0 ) according to the gyro offset gradually 
20 increases as time passes. 

With reference to Figure 4C, the amount of rotation is calculated on the 
basis of the offset value (Goffset) of the gyro sensor during the time interval (t new ~ 
toid) before the new gyro offset value (G 0 ffset,new) is determined, which, however, 
fails to reflect the offset value of the gyro sensor changed during the time interval 

25 (t new ~ toid). 
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In order to reflect to the changed offset value of the gyro sensor, the 
rotational position error of the robot cleaner is compensated on the basis of the 
new gyro offset value. The rotational position error of the gyro offset is Err 2 = A 2 - 
A 0 , and its size is smaller than the rotational position error of Figure 4B. 

5 Accordingly, as shown in Figure 4D, when the previous gyro offset 

(Goffset.oid) is linearly changed to the new gyro offset, the amount of rotation 
according to the gyro offset during the time period (t ne w ~ W is calculated, the 
calculated amount of rotation is subtracted from the amount of rotation according 
to the previously calculated gyro offset, and the subtracted amount of rotation is 

10 compensated, thereby reducing a rotational position error of the robot cleaner. The 
compensated amount of rotation is obtained by below equation (6): 

VLT — XLf _ \I/ —VU —\.(Cj — G ) • (t ~t } (6) 

A n+l A n+l, previous compensation A n+l ^V^* offset, new w offset , old ' V new old' V / 

wherein \|/ n+ i is the compensated amount of rotation of the robot cleaner, 
Vn+i .previous is the amount of rotation of the robot cleaner before compensation, and 
15 M/compensation is the rotation compensation amount of the robot cleaner. \[/ C om P ensation 
corresponds to A 4 of Figure 4D, and in this case, a rotational position error 
according to the gyro offset is Err 3 = A 3 - A 0 = (A 2 - A 4 ) - A 0 . That is, the rotational 
position error of the robot cleaner can be expressed in order from Figures 4A-4D 
by Erri>Err 2 >Err 3 . 

20 Meanwhile, in the present invention, the rotational position error of the 

robot cleaner can be reduced by compensating an offset value of various sensors 
which detects a rotation speed (angular velocity) of the robot cleaner. 

As so far described, the method for compensating a rotational position 
error of a robot cleaner in accordance with the present invention has the following 



advantages. 

That is, for example, an offset value of the gyro sensor detecting a rotation 
speed of the robot cleaner is detected whenever the robot cleaner temporarily 
stops and the detected offset value of the gyro sensor is compensated, so that a 
5 rotational position error of the robot cleaner can be reduced. 

In addition, when an offset value of the gyro sensor when the robot 
cleaner temporarily stops after a certain time lapse is sharply changed or when a 
cleaning step is changed, an offset value of the gyro sensor of the robot cleaner is 
detected. Accordingly, the offset value can be accurately detected, and thus, a 
10 rotational position error according to the change in the offset of the gyro sensor 
can be minimized. 

As the present invention may be embodied in several forms without 
departing from the spirit or essential characteristics thereof, it should also be 
understood that the above-described embodiments are not limited by any of the 
15 details of the foregoing description, unless otherwise specified, but rather should 
be construed broadly within its spirit and scope as defined in the appended claims, 
and therefore all changes and modifications that fall within the metes and bounds 
of the claims, or equivalence of such metes and bounds are therefore intended to 
be embraced by the appended claims. 

20 
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